/* 
 * 
 * Confidential Information of Telekinesys Research Limited (t/a Havok).  Not for disclosure or distribution without Havok's
 * prior written consent.This software contains code, techniques and know-how which is confidential and proprietary to Havok.
 * Level 2 and Level 3 source code contains trade secrets of Havok. Havok Software (C) Copyright 1999-2008 Telekinesys Research Limited t/a Havok. All Rights Reserved. Use of this software is subject to the terms of an end user license agreement.
 * 
 */

void hkpPhysicsCommandQueue::init(hkpPhysicsCommand* bufferStart, int capacity)
{
	m_start.set( bufferStart );
	m_size = 0;
	m_capacity = capacity;
}

hkpPhysicsCommandQueue::hkpPhysicsCommandQueue( hkpPhysicsCommand* bufferStart, int capacity )
{
	init(bufferStart, capacity);
}

template<typename COMMAND_STRUCT> 
void hkpPhysicsCommandQueue::addCommand(COMMAND_STRUCT command)
{
	hkpPhysicsCommand* current = hkAddByteOffset( m_start.val(), m_size );
	COMMAND_STRUCT& dest = static_cast<COMMAND_STRUCT&>(*current);
	dest = command;
	int size = HK_NEXT_MULTIPLE_OF(16, sizeof(COMMAND_STRUCT) );
	m_size += size;
	HK_ASSERT2( 0xf03234f5, m_size <= m_capacity, "Running out of command buffer" );
}

template<typename COMMAND_STRUCT> 
COMMAND_STRUCT& hkpPhysicsCommandQueue::newCommand()
{
	hkpPhysicsCommand* current = hkAddByteOffset( m_start.val(), m_size );
	COMMAND_STRUCT* res = new (current)COMMAND_STRUCT();
	int size = HK_NEXT_MULTIPLE_OF(16, sizeof(COMMAND_STRUCT) );
	m_size += size;
	HK_ASSERT2( 0xf03224f5, m_size <= m_capacity, "Running out of command buffer" );
	return *res;
}

template<int NUM_BYTES>
hkpFixedSizePhysicsCommandQueue<NUM_BYTES>::hkpFixedSizePhysicsCommandQueue() :
	hkpPhysicsCommandQueue( (hkpPhysicsCommand*)&m_buffer[0], NUM_BYTES )
{
}

/*
* Havok SDK - NO SOURCE PC DOWNLOAD, BUILD(#20080529)
*
* Confidential Information of Havok.  (C) Copyright 1999-2008 
* Telekinesys Research Limited t/a Havok. All Rights Reserved. The Havok
* Logo, and the Havok buzzsaw logo are trademarks of Havok.  Title, ownership
* rights, and intellectual property rights in the Havok software remain in
* Havok and/or its suppliers.
*
* Use of this software for evaluation purposes is subject to and indicates 
* acceptance of the End User licence Agreement for this product. A copy of 
* the license is included with this software and is also available at
* www.havok.com/tryhavok
*
*/
